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1  Introduction 


Increasing  interest  in  manipulator  redundancy  is  a  direct  consequence  of  perceived 
limitations  of  current  6  degree  of  freedom  robots.  On  the  one  hand,  singularity  regions 
of  6  degree  of  freedom  rotary  manipulators  occupy  such  a  significant  portion  of  the 
workspace  as  to  render  them  functionally  only  5  degree  of  freedom  manipulators  (Paul 
and  Stevenson,  1983).  On  the  other  hand,  workspace  obstacles  may  sufficiently  constrain 
movement  as  to  effectively  reduce  the  degrees  of  freedom. 

Most  analysis  of  redundant  arms  has  proceeded  independent  of  consideration  of  any 
particular  mechanism.  Hollerbach  (1984b,  1985)  proposed  a  7  degree  of  freedom  kine- 
matic  design  with  a  spherical  shoulder  joint  to  eliminate  singularities  and  to  improve 
workspace.  Yoshikawa  (1985a)  proposed  a  4  degree  of  freedom  wrist  to  overcome  the 
usual  problem  of  wrist  singularity.  In  practice  very  few  redundant  manipulators  have 
been  constructed.  At  research  laboratories,  7  degree  of  freedom  arms  of  anthropomor¬ 
phic  geometry  include  a  tendon-driven,  torque-controlled  robot  (Takase,  Inoue,  and 
Sato,  1974)  and  the  UJIBOT,  driven  by  DC  servo  motors  (Nakamura,  1985).  An  8 
degree  of  freedom  redundant  sheep-shearing  robot  has  been  discussed  in  (Trevelyan, 
Kovesi,  and  Ong,  1983).  Commercially,  7  degree  of  freedom  robots  have  been  produced 
by  the  Robotics  Research  Corp.,  also  of  anthropomorphic  geometry,  and  by  Cybotech, 
whose  P-15  robot  has  a  yaw  axis  in  the  forearm  (Litvin  et  al.,  1985).  In  addition,  a 
number  of  6  degree  of  freedom  robots  have  been  mounted  on  linear  tracks,  but  it  is  hard 
to  count  this  7th  degree  of  freedom  into  fine  motion  control  of  the  endpoint. 

Thus,  while  the  incidence  of  redundant  arms  in  research  labs  and  industry  is  grad¬ 
ually  increasing,  present  research  in  redundant  arms  has  progressed  primarily  at  a 
theoretical  and  simulation  level,  in  advance  and  expectation  of  available  mechanical 
hardware. 

1.1  Kinematic  Resolution  of  Redundancy 

The  vast  majority  of  research  into  the  control  of  redundant  arms  has  involved  the 
instantaneous  resolution  of  the  redundancy  at  the  velocity  level  through  use  of  the 
pseudoinverse  of  the  Jacobian  matrix  J.  If  x  is  the  6-dimensional  velocity  vector  of 
the  hand  and  0  is  the  n  >  6  dimensional  vector  of  joint  angles,  then 

x  =  J{?  (1) 

$  =  jtx+(I-jtj)£  (2) 

jt  =  JT(JJr)-‘  (3) 

where  ^  is  an  arbitrary  joint  velocity  vector  and  (I- J^J)<jl»  is  its  projection  into  the  null 
space  of  J,  corresponding  to  a  self-motion  of  the  linkage  that  does  not  move  the  end 
effector.  The  pseudoinverse  is  also  known  as  the  Moore-Penrose  generalized  inverse.  The 
attractiveness  of  this  approach  is  twofold.  First,  the  pseudoinverse  is  one  of  the  types 
of  generalized  inverse  that  has  a  least  squares  property  (Ben-Israel  and  Greville,  1980), 

■  T  • 

in  the  present  case  minimizing  0  0.  Presumably  any  joint  is  prevented  from  moving  too 
fast,  leading  to  a  more  controllable  motion  (Whitney,  1969).  It  is  also  presumed  that 


squared  velocities  are  approximately  related  to  kinetic  energy,  which  would  then  also 
be  approximately  minimized  (Whitney,  1969,  1972). 

Second,  the  redundancy  available  beyond  that  required  for  the  tip  motion  is  suc¬ 
cinctly  characterized  by  the  null  space  of  the  Jacobian,  which  may  be  freely  utilized  to 
assist  in  the  realization  of  some  chosen  objective.  Liegeois  (1977)  developed  a  general 
formulation  for  instantaneously  minimizing  a  position-dependent  scalar  performance 
criterion  p  =  <jr(0).  The  null  space  vector  that  minimizes  pis  <f>  =  kdg/36,  where  k  is  an 
arbitrary  constant,  and  yields  the  solution 


9  =  jti+(I-  jtj)jfc 


3? 

36 


(4) 


Liegeois  demonstrated  a  way  of  avoiding  joint  limits,  by  minimizing  the  scalar  function 

_f*(  ti  -  ofd  V 

P  _  flmaz  J 


(5) 


where  0,maI  and  0™,n  are  the  upper  and  lower  joint  angle  limits  for  joint  i  and  0!m<<  = 

(0Jmn  +  0™az) /2. 

The  null  space  vector  has  also  been  used  in  singularity  avoidance.  Yoshikawa  (1984) 
proposed  minimizing  a  dexterity  measure  wt  called  by  him  the  manipulatability  measure, 
given  by  _ 

u>  =  x/det(JJr)  (6) 

Since  at  a  singularity  w  =  0,  then  the  scalar  function  p  =  -w(9)  instantaneously 
maximizes  w  and  tends  to  keep  the  arm  away  from  singularities.  Klein  (1985)  compared 
various  dexterity  measures  including  w  and  decided  instead  on  the  minimum  singular 
value. 

At  a  singularity  a  nonredundant  manipulator  can  actually  execute  a  self  motion, 
since  for  example  a  6  degree  of  freedom  robot  has  an  excess  freedom  with  regard  to  the 
5  degree  of  freedom  endpoint  motion  possible  at  the  singularity.  The  null  space  vector 
corresponding  to  this  self  motion  is  useful  if  the  endpoint  variables  are  partitioned 
into  high-priority  variables  xh,  which  must  be  realized,  and  low-priority  variables  z„ 
which  are  sacrificed  to  avoid  the  singularity  but  which  should  be  realized  insofar  as  is 
possible  (Hanafusa,  Yoshikawa,  and  Nakamura,  1981).  For  example,  in  spray  painting 
the  control  of  rotation  about  the  spray  direction  is  not  as  important  as  the  control  of  the 
other  positioning  variables,  and  could  be  sacrificed  at  a  singularity.  From  the  relations 


¥h  - 


J  k9 


-  J,0 


*  =  +  (I  -  jJjfc)^ 


(7) 

(8) 
(9) 


the  null  space  vector  left  over  after  realizing  the  high  priority  variables  is  found  by 
substituting  (9)  into  (8): 


i  =  |J,(I  -  jUMa  - 


(10) 


2 


a 


Substituting  into  (9)  yields 

o = j!*» + [j«(i  -  jU))f  (?,  - 


(u) 


where  use  has  been  made  of  the  identity  B[CB]^  =  [C2?]t ,  with  B  =  (I  -  J^Jh)  a 
hermetian  and  idempotent  matrix  (Maciejewski  and  Klein,  1985) . 

The  null  space  vector  can  aid  obstacle  avoidance  (Maciejewski  and  Klein,  1985). 
Suppose  x0  is  some  point  on  the  arm  closest  to  an  obstacle,  J0  is  the  Jacobian  such 
that  x0  =  309,  and  x0  is  a  movement  of  this  point  away  from  the  obstacle  that  would 
be  desirable.  In  a  procedure  like  that  above,  <f>  is  found  by  substituting  (1)  into  this 
relation: 

'<t  =  (Jo(I  -  jf  J)]t  (?o  -  -U1?)  (12) 

After  substitution  and  simplification,  the  joint  rates  that  avoid  the  obstacle  are: 


9  =  jt*  +  [ J0(I  -  jt  J)]t (io  _  j0jt i) 


(13) 


One  problem  with  the  Moore-Penrose  inverse  is  that  its  application  is  nonconserva¬ 
tive  (Klein  and  Huang,  1983).  Repetitive  motions  planned  with  the  pseudoinverse  alone 
do  not  return  at  a  given  tip  point  to  the  same  joint  configuration.  Baillieul  (1985)  has 
proposed  an  extended  Jacobian  method,  which  may  be  used  to  make  a  repetitive  motion 
conservative.  If  n,  is  a  vector  from  the  one-dimensional  null  space  of  J,  obtained  by 
taking  cross  products  of  columns  of  J,  and  g(0)  is  a  scalar  function  to  be  minimized, 
then  define 

««>  = 

The  extended  Jacobian  Jex  is  then  defined  by 


(14) 


X 

J  ' 

Jj_  = 

0 

>  J**  — 

0G 

L  W 

(15) 


Assuming  the  manipulator  is  nonsingular,  this  relation  may  be  inverted  directly  to  find 
6.  It  is  possible  to  recast  this  method  in  terms  of  a  generalized  inverse  with  null  space 
vector. 

An  entirely  different  mechanism  from  use  of  a  null  space  vector  to  realize  desired 
performance  characteristics  is  the  weighted  pseudoinverse.  The  generalized  inverse  jtw 


that  instantaneously  minimizes  the  cost  9  W9  is  (Whitney,  1969,  1972) 

jtw  =  W_1Jr(JW_1JT)_1 


(16) 


where  W  is  a  matrix  of  weights.  Whitney  (1969)  proposed  an  alternative  method 
for  enforcing  high  and  low  priority  of  hand  variables  through  appropriate  selection  of 
weights.  Konstantinov,  Markov,  and  Nenchev  (1981)  used  weights  to  avoid  joint  limits. 

Most  research  involving  the  pseudoinverse  deals  with  the  instantaneous  kinematics 
of  motion,  that  is  to  say,  motion  that  is  locally  optimized  by  incremental  movement 


a 


& 


3 


from  the  current  arm  state.  The  Jacobian  has  also  been  used  in  dexterity  measures  to 
aid  global  trajectory  planning  and  the  avoidance  of  singularities.  Uchiyama,  Shimizu, 
and  Hakomori  (1985)  parameterized  joint  angles  by  polynomials  and  optimized  manipu- 
latability  w  integrated  across  the  whole  trajectory  by  gradient  adjustment  of  polynomial 
coefficents.  Nakamura  and  Hanafusa  (1985)  used  Pontryagin’s  Maximum  Principle  to 

.  T  • 

minimize  a  cost  function  combining  manipulatability  to,  and  9  9,  interpreted  by  them 
as  energy,  for  global  determination  of  trajectory. 

1.2  Kinetic  Resolution  of  Redundancy 

The  previous  redundancy  resolution  schemes  are  purely  kinematic,  despite  the  pre¬ 
sumption  that  since  the  sum  of  squares  of  joint  velocities  is  minimized  by  the  pseu¬ 
doinverse,  then  the  kinetic  energy  is  approximately  minimized.  True  minimization  of 
kinetic  energy  would  only  be  realized  if  the  generalized  inverse  were  weighted  with  the 
inertia  matrix,  so  that  the  relation  to  kinetic  energy  of  an  unweighted  pseudoinverse  is 
not  clear.  The  kinetic  energy  is 

r  =  \iTK9  (17) 

where  H  is  the  inertia  matrix.  Minimizing  the  kinetic  energy  T  is  just  Whitney’s 
criterion  with  the  weighting  matrix  W  =  H  in  (16). 

To  incorporate  the  generalized  inverse  into  dynamics,  the  pseudoinverse  must  be 
formulated  in  terms  of  accelerations.  Khatib  (1980, 1983)  was  one  of  the  first  researchers 
to  do  this,  in  his  case  using  the  inertia-weighted  pseudoinverse: 

x  =  J9  +  39 
9  = 

The  dynamic  equations  in  closed  form  are  (Hollerbach,  1984) 

r  =  H0  +  0C-0  +  g.  (20) 

where  previously  undefined  terms  are  C,  the  matrix  of  Coriolis  and  centrifugal  coeffi¬ 
cients,  and  g,  the  gravity  vector.  Hence  the  joint  torques  are  given  by 

r  =  HjtH(x-  J0)  +  0-C  9  +  g.  (21) 

Vukobratovic  and  Kircanski  (1985)  broadened  the  method  of  Khatib  to  include  en¬ 
ergetic  models  of  hydraulic  and  electromagnetic  motors,  and  applied  the  resultant  gen¬ 
eralized  inverse  to  velocities. 

While  kinetic  resolution  of  redundancy  incorporates  dynamics,  the  resulting  formu¬ 
lation  is  only  indirectly  related  to  torque  production  at  the  joints.  A  major  reason  for 
attempting  to  reflect  directly  the  effect  of  redundancy  on  joint  torque  is  to  avoid  ex¬ 
ceeding  torque  limits.  Past  work  has  been  concerned  with  characterizing  the  endpoint 
accelerations  that  depend  on  the  utilization  of  the  redundancy  and  on  torque  limits, 


(18) 

(19) 


rather  than  on  an  actual  application  to  trajectory  planning.  Yoshikawa  (1985b, c)  de¬ 
fined  a  dynamic  manipulability  ellipsoid,  derived  from  a  pseudo-endpoint  acceleration 
“  •  •  •  • 

x  —  x  —  J$  related  to  a  pseudo-torque  t  =  t—  O-C-O  —  g  by 

|  =  JH_1r  (22) 

The  derivation  proceeds  at  zero  velocity  by  a  kind  of  normalization  of  the  torques 
according  to  range.  The  upper  r+  and  lower  r~  joint  torque  bounds  are  presumed  equal, 
and  each  pseudo-joint  torque  is  normalized  as  ?,■  =  Ti/(r+  —  (gj).  Ignoring  bounds  on 
acceleration,  then 

|  =  JH_1£  (23) 

where  H  =  WH  and  W  =  diag(l/(r+  —  |gj))  is  a  diagonal  weighting  matrix.  The 
dynamic  manipulability  ellipsoid  consists  of  the  set  of  x  that  are  derivable  from  a  unit 
input  t  <  1,  obtained  from  the  dot  product 

|T(Hjt)THjt|<  l  (24) 

The  dynamic  manipulability  index  to  is  derived  from  this  relation,  and  is  an  extension 
of  (6)  through  the  inclusion  of  inertia: 

to  =  \/det(J(HrH)-1JT)  (25) 

This  index  has  not  yet  been  applied  to  redundancy  resolution. 

Khatib  (1985)  presented  a  different  normalization  for  torque  range  in  a  procedure 
similar  to  Yoshikawa’s.  Defining 

f,-  =  msn(|rf  -  g,|,  \rf  -  g,|) 

the  weighting  matrix  is  W  =  d*ag(l/fj).  Khatib  applied  this  procedure  to  adjust  a  two- 
link  manipulator’s  link  lengths  and  masses  to  optimize  the  isotropic  nature  of  endpoint 
acceleration  throughout  the  workspace. 

This  paper  reports  on  a  method  for  instantaneously  minimizing  torque  loading  at 
the  joints  in  a  least  squares  sense,  by  specification  of  a  null  space  vector  applied  to 
generalized  inverse  accelerations  and  derived  from  manipulator  dynamics.  This  method 
is  compared  to  use  of  a  straightforward  pseudoinverse  and  to  use  of  an  inertia-weighted 
pseudoinverse  with  regard  to  the  effect  on  joint  torques.  Portions  of  this  research  have 
been  previously  reported  (Baillieul,  Hollerbach,  and  Brockett,  1984;  Hollerbach  and 
Suh,  1985). 

2  The  Generalized  Inverse  and  Torque  Optimization 

Consider  an  n  degree  of  freedom  manipulator  whose  task  is  described  by  m  hand 
variables  x,  where  m  <  n.  Assume  that  the  upper  and  the  lower  torque  limits  of  the 
joints  are  r+  and  r~  respectively,  where  for  simplicity  the  limits  are  assumed  motion 
independent.  Then  given  a  desired  hand  trajectory  x(t),  we  would  like  to  find  the  set 


of  joint  torques  that  results  in  x(t)  and  at  the  same  time  reduces  actuator  demands. 
One  way  of  reducing  the  actuator  demands  is  to  place  the  joint  torques  closest  to  the 
midpoint  of  the  joint  torque  limits  |(r+  +  r~).  In  the  following,  a  method  is  presented 
for  finding  this  set  of  joint  torques  using  the  null  space  of  the  Jacobian  matrix. 

In  order  to  incorporate  dynamics,  the  redundancy  is  resolved  at  the  acceleration 
level  rather  than  at  the  velocity  level.  Using  the  pseudoinverse,  the  inverse  kinematics 
readily  follows  from  (18). 

0  =  jt(*-  jtf)  +  (I-jtj)£  (26) 

where  the  null  space  vector  (I  —  J^J)^>  now  appears  relative  to  (19).  Substituting  (26) 
into  (20), 

r  =  r  +  H(I-  jtj)£  (27) 

where 

f  =  Hjt(x-  3O)  +  0-C-O  +  g.  (28) 

The  goal  is  to  place  t  closest  to  |(r+  +  r_)  in  a  least  squares  sense,  that  is  to  say,  to 
minimize 

||l  -  ^"1  (») 

Substituting  (27)  into  (29)  and  defining  r +  =  r+  -  t  and  t~  —  r"  -  r,  the  goal  is  recast 
as  finding  the  vector  <t>  to  minimize 


H(I  -  jU)j>  - 


t+  +  r\\2 


This  least  squares  problem  can  also  be  solved  by  the  generalized  inverse  (Ben-Israel  and 
Greville,  1980),  yielding 

^  =  [h(I  -  jtj)]+ (21) 

This  result  can  be  extended  to  incorporate  the  idea  that  the  available  torque  range  is 
smaller  for  some  joints  than  for  others,  through  the  use  of  weighted  least  squares  (Ben- 
Israel  and  Greville,  1980).  Given  a  weighting  matrix  W,  we  now  want  to  minimize 


The  solution  to  this  is  given  by 


£=  W*H(I-  jtj)]1  ti- 


where  by  definition  =  W.  Torque  range  can  be  incorporated  into  the  least 

squares  by  a  diagonal  matrix  W  =  diag(l/(T+  -  r")2).  Weighting  the  least  squares  by 


Figure  1:  Geometry  of  the  three-link  planar  manipulator. 


the  magnitude  of  the  torque  range  seems  a  better  procedure  than  the  weighting  schemes 
of  Khatib  and  Yoshikawa,  which  are  biased  towards  zero. 

3  Simulation 

The  various  algorithms  for  redundancy  resolution  at  the  acceleration  level  are  demon¬ 
strated  by  simulation. 

1.  The  unweighted  pseudoinverse  algorithm  derives  the  joint  torques  from  (27)  and 
(28). 

r  =  Hjt(i-  j»)  +  »C#  +  9.  (34) 

2.  The  inertia-weighted  pseudoinverse  algorithm  is  obtained  from  (21). 

r  =  HjtH  (x-j9)  +  9’C-9  +  g.  (35) 

3.  The  unweighted  null-space  algorithm  derives  the  joint  torques  from  (27),  (28),  and 

(31).  t  *+ 

r  =  j0)  +  0-C-0  +  g  +  H[H(I-  jtj)]  (36) 

4.  The  weighted  null-space  algorithm  is  derived  from  (27),  (28),  and  (33). 

r  =  Hjt(x-  j$)  +  ?-C-i  +  ?  +  H[w*H(I-  jtj)jt  ^W?L+±---j  (37) 

Methods  3  and  4  again  make  use  of  the  identity  B[CB ]t  =  [CJ3]t,  where  B  =  (I  -  J^J) 
is  hermetian  and  idempotent  (Maciejewski  and  Klein,  1985). 

The  simulated  manipulator  is  a  planar  rotary  manipulator  with  three  links  (Fig¬ 
ure  1).  The  parameters  of  the  arm  are  link  lengths  /j  =  h  —  Is  =  1.0  and  masses 


mi  =  m2  =  ms  =  10.0;  link  inertias  are  modeled  by  thin  uniform  rods.  The  simulated 
movements  are  straight-line  Cartesian  paths  starting  and  ending  with  zero  velocity,  with 
constant  tangential  acceleration  and  deceleration  of  the  magnitude  \/2  over  first  and 
last  half  of  the  movement  respectively.  Total  duration  of  the  movement  is  varied  to 
give  the  trajectories  of  different  lengths.  Tip  orientation  is  not  constrained,  giving  one 
degree  of  freedom  redundancy.  For  simplicity  gravity  is  ignored,  and  the  upper  and 
lower  torque  limits  are  set  equal  in  magnitude  yielding  r+  4-  t~  =  0.  Torque  limits  for 
joints  1-3  are  set  at  54,  24,  and  6  respectively,  derived  from  ratios  of  mass  moments 
at  each  joint  when  the  arm  is  perfectly  straight  to  ensure  appropriate  relative  scaling. 
For  the  weighted  null-space  algorithm,  the  diagonal  elements  of  the  weighting  matrix 
W  were  set  as  the  inverse  squares  of  these  torque  limits. 

The  pseudoinverse  was  found  using  the  singular  value  decomposition  of  a  matrix 
(Strang,  1980),  via  a  routine  taken  from  Linpak  User’s  Guide  (Dongarra,  1979).  After 
the  joint  torques  were  found,  a  fourth-order  Runge-Kutta  algorithm  was  used  to  find  the 
next  joint  velocities  and  angles  with  an  integration  time  interval  of  1  msec.  Programs 
were  written  in  Fortran  77  in  single  precision  and  ran  on  the  VAX  11/750  computer 
running  4.2  BSD  UNIX. 

4  Results 

Performance  of  the  unweighted  null-space  and  pseudoinverse  algorithms  are  com¬ 
pared  in  Figs.  2-4  for  representative  trajectories.  For  the  short  movement  of  Fig.  2, 
the  null-space  algorithm  seems  to  give  a  substantial  reduction  in  required  joint  torques. 
The  most  dramatic  decrease  is  in  the  joint  1  torque,  which  is  much  smaller  than  for 
the  unweighted  pseudoinverse  algorithm.  While  the  other  joint  torques  in  the  present 
example  are  decreased  less,  the  joint  3  torque  is  pulled  away  from  the  perilously  close 
torque  limit  of  6.  For  the  intermediate  length  movement  of  Fig.  3,  which  is  2.5  times  as 
long  as  in  Fig.  2,  the  unweighted  null-space  algorithm  still  outperforms  the  unweighted 
pseu^oinverse  algorithm,  although  near  the  movement  midrange  and  end  the  joint  2 
torques  are  somewhat  larger  though  still  within  the  torque  range. 

For  the  long  movement  of  Fig.  4,  which  is  four  times  as  long  as  in  Fig.  2,  the 
unweighted  null  space  algorithm  unexpectedly  encounters  stability  problems  near  the 
movement  end.  The  torques  required  to  keep  the  manipulator  endpoint  on  the  planned 
trajectory  become  extremely  high,  occasioned  by  the  joint  alignment  of  links  2  and  3 
coupled  with  large  velocities  and  accelerations  in  all  the  joints  (Fig.  5).  Evidently 
the  unweighted  null-space  algorithm  needs  a  long  enough  path  for  this  situation  to 
develop.  Indeed,  nearly  any  long  path  led  to  similar  instability  problems,  since  joint 
alignment  and  high  velocities  inevitably  followed.  This  rarely  happened  in  the  case  of 
the  unweighted  pseudoinverse  algorithm.  Although  the  unweighted  null-space  algorithm 
instantaneously  gives  smaller  torques  than  the  unweighted  pseudoinverse  algorithm, 
globally  the  unweighted  null-space  algorithm  degrades  unacceptably  in  performance 
with  longer  trajectories. 

Ordinarily  one  would  expect  a  proximal  joint  such  as  joint  1  to  have  a  larger  actuator 
and  a  wider  torque  range  than  the  distal  joints,  since  it  is  required  to  exert  more  torque. 
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Figure  4:  Long  movement  showing  instability. 

Yet  in  the  unweighted  torque  optimization  all  joints  are  treated  equal;  the  sum  of  squares 
of  joint  torques  is  minimized  by  reducing  the  largest  torque  which  is  the  joint  1  torque 
by  generating  high  accelerations  at  all  the  joints.  If  the  torque  optimization  is  done 
relative  to  the  allowable  torque  range  at  each  joint,  the  instability  problem  may  be 
overcome. 

To  test  this  idea,  performance  of  the  weighted  null-space  algorithm  is  examined  for 
the  same  trajectory  as  in  Fig.  2.  It  can  be  seen  that  the  joint  3  torque  is  now  much 
smaller  at  the  expense  of  more  torque  at  joints  1  and  2,  but  all  remain  well  within  their 
torque  ranges  (Fig.  6).  Unfortunately,  the  weighted  null-space  algorithm  also  yields 
stability  problems  for  the  long  movement  of  Fig.  4,  so  that  the  hoped-for  elimination  of 
instability  with  weights  is  not  realized.  There  were  even  movements  where  the  instability 
was  shown  only  by  the  weighted  case,  although  the  reverse  was  not  found.  The  observed 
characteristics  of  the  instability  in  the  weighted  cases  were  identical  to  those  of  the  non- 
weighted  cases. 

Performance  of  the  inertia-weighted  pseudoinverse  algorithm  is  also  shown  in  Fig. 
6.  Here  and  elsewhere  the  joint  torques  fell  somewhere  in  between  the  unweighted 
pseudoinverse  algorithm  and  the  unweighted  null-space  algorithm.  The  inertia-weighted 
pseudoinverse  algorithm  also  suffered  from  instabilities  in  longer  movements.  In  most 
of  the  trajectories  studied,  whenever  the  null-space  algorithm  was  unstable,  the  inertia- 
weighted  pseudoinverse  algorithm  was  unstable  as  well. 

5  Discussion 

The  goal  of  this  paper  was  to  develop  a  local  algorithm  for  reducing  actuator  require- 
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Figure  7:  A  free-swinging  pendulum  acting  under  the  influence  of  gravity  directed  along 
the  former  straight-line  motion 

ments  and  avoiding  torque  limits,  and  the  methods  examined  include  use  of  a  null-space 
acceleration  vector,  this  vector  weighted  by  torque  range,  and  an  inertia-weighted  pseu¬ 
doinverse.  These  kinetic  methods  all  lead  to  stability  problems,  even  though  locally 
these  methods  reduce  actuator  torques.  Globally  only  the  unweighted  pseudoinverse  al¬ 
gorithm,  which  by  contrast  is  a  kinematic  method,  is  generally  well-behaved,  although 
on  rare  occasions  it  too  shows  instabilities. 

It  seems  that  local  tampering  with  the  energetics  of  movement  has  led  to  global 
disaster.  The  torque  profiles  in  Fig.  4  are  representative  of  the  problem.  High  acceler¬ 
ations  in  the  distal  joints  lead  to  high  joint  velocities,  and  at  the  point  where  the  third 
joint  is  straight  these  high  velocities  induce  a  whipping  action  that  strongly  thrusts 
the  endpoint  off  the  path.  Substantial  torques  are  required  to  overcome  these  natural 
movement  dynamics  and  to  maintain  the  planned  endpoint  trajectory. 

Insofar  as  torque  optimization  tends  to  reduce  the  torques  towards  zero,  the  situation 
may  be  analogous  to  a  free-swinging  pendulum.  In  Fig.  7  the  manipulator  has  been 
started  at  the  same  position  as  the  previous  plots,  but  with  gravity  now  acting  along 
the  original  straight-line  motion  with  a  magnitude  that  yields  an  initial  acceleration 
equal  to  the  acceleration  step  in  the  simulated  trajectories.  The  manipulator  is  allowed 
to  fall  freely  under  the  influence  of  this  gravity.  The  free-swinging  pendulum  exhibits  a 
similar  whipping  action  when  the  third  joint  straightens  out.  Thus  the  kinetic  methods 
do  indeed  lead  to  utilization  of  the  natural  movement  dynamics,  but  ultimately  to 
the  detriment  of  the  movement  goals  with  which  the  natural  movement  dynamics  are 
incompatible. 

Whether  the  kinetic  methods  may  be  modified  to  avoid  the  instabilities  is  a  subject 
of  continuing  research.  One  possibility  is  to  weight  the  local  optimization  criterion  with 
a  kinematic  term  to  avoid  high  velocity  buildup.  For  staying  within  torque  bounds, 


linear  programming  lather  than  least  squares  may  be  more  satisfactory.  The  broader 
question  is  whether  any  local  algorithm  can  ever  be  completely  successful,  or  whether 
ultimately  only  a  global  resolution  of  redundancy  can  be  guaranteed  problem-free. 

Acknowledgments 

We  wish  to  acknowledge  discussions  with  Roy  Featherstone  into  causes  of  the  in¬ 
stability,  and  additionally  one  of  us  (JMH)  acknowledges  the  many  useful  discussions 
concerning  redundant  arms  with  Roger  Brockett  and  John  Baillieul. 

References 

Baillieul,  J.,  1985,  "Kinematic  programming  alternatives  for  redundant  manipula¬ 
tors,”  Proe.  IEEE  Conf.  Robotics  and  Automation ,  St.  Louis,  Mar.  25-28,  pp. 
722-728. 

Baillieul,  J.,  Hollerbach,  J.M.,  and  Brockett,  R.,  1984,  "Programming  and  control  of 
kinematically  redundant  manipulators,”  Proc.  2Srd  IEEE  Conference  on  Decision  and 
Control,  Las  Vegas,  Nevada,  December  12-14,  pp.  768-774. 

Ben-Israel,  A.  and  Greville,  T.N.E.,,  1980,  Generalized  Inverses:  Theory  and  Appli¬ 
cations,  New  York,  Robert  E.  Krieger  Publishing  Co.. 

Dongarra,  J.J.,  Moler,  C.B.,  Bunch,  J.R.,  and  Stewart,  G.W.,  1979,  LINPAK  User's 
Guide,  Philadelphia,  SIAM. 

Hanafusa,  H.,  Yoshikawa,  T.,  and  Nakamura,  Y.,  1981,  "Analysis  and  control  of 
articulated  robot  arms  with  redundancy,”  Prep.  8th  IF  AC  World  Congress,  August, 
pp.  XIV-78-83. 

Hollerbach,  J.M.,  1984a,  "Dynamic  scaling  of  manipulator  trajectories,”  ASME  J. 
Dynamic  Systems,  Meas.,  Control,  106,  pp.  102-106. 

Hollerbach,  J.M.,  1985,  “Optimum  kinematic  design  for  a  seven  degree  of  freedom 
manipulator,”  Robotics  Research:  The  Second  International  Symposium,  edited  by  H. 
Hanafusa  and  H.  Inoue,  Cambridge,  Mass.,  MIT  Press,  pp.  215-222. 

Hollerbach,  J.M.,  1985,  "Evaluation  of  redundant  manipulators  derived  from  the 
PUMA  Geometry,”  ASME  Winter  Annual  Meeting:  Robotics  and  Manufacturing  Au¬ 
tomation,  PED-Vol.  15,  Miami  Beach,  Nov.  17-22,  pp.  187-192. 

Hollerbach,  J.  M.,  and  Sahar,  G.,  1983,  "Wrist-partitioned  inverse  kinematic  accel¬ 
erations  and  manipulator  dynamics,”  Int.  J.  Robotics  Research,  2  no.  4,  pp.  61-76. 

Hollerbach,  J.M.,  and  Suh,  K.C.,  1985,  "Redundancy  resolution  of  manipulators 
through  torque  optimization,”  Proc.  IEEE  Int.  Conf.  Robotics  and  Automation,  St. 
Louis,  March  25-28,  pp.  1016-1021. 


■  ftfl  IW  ft.  |v. 


^  ~  ttAAVI 


Khatib,  O.,  1980,  Commande  Dynamique  dans  1’Espace  Operationnel  des  Robots 
Manipulateurs  en  Presence  d’Obstacles,  Docteur  Ingenieur  Thesis,  L’Ecole  Nationale 
Superieure  de  l’Aeronautique  et  de  l’Espace. 


Khatib,  O.,  1983,  “Dynamic  control  of  manipulators  in  operational  space,”  6th 
IFToMM  Congress  on  Theory  of  Machines  and  Mechanisms ,  New  Delhi,  Dec.  15- 
20,  pp.  1123-1131. 


Khatib,  O.,  1985,  “The  operational  space  formulation  in  the  analysis,  design,  and 
control  of  robot  manipulators,”  Preprints  3rd  International  Symposium  of  Robotics  Re¬ 
search,  Gouvieux  (Chantilly),  France,  October  7-11,  pp.  103-110. 


Kircanski,  M.,  and  Vukobratovic,  M.,  1985,  “Trajectory  planning  for  redundant 
manipulators  in  the  presence  of  obstacles,”  Theory  and  Practice  of  Robots  and  Manip¬ 
ulators.  Proceedings  of  RoManSy  ‘ 84 :  the  Fifth  CISM-IFToMM  Symposium,  edited  by 
A.  Morecki,  G.  Bianchi,  and  K.  Kedzior,  Cambridge,  Mass.,  MIT  Press,  pp.  57-64. 


Klein,  C.A.,  1985,  “Use  of  redundancy  in  the  design  of  robotic  systems,”  Robotics 
Research:  The  Second  International  Symposium,  edited  by  H.  Hanafusa  and  H.  Inoue, 
Cambridge,  Mass.,  MIT  Press,  pp.  207-214. 


Klein,  C.A.,  and  Huang,  C.H.,  1983,  “Review  of  pseudoinverse  control  for  use  with 
kinematically  redundant  manipulators,”  IEEE  Trans.  Systems,  Man,  Cybern.,  SMC-13, 
pp.  245-250. 


Konstantinov,  M.S.,  Markov,  M.D.,  and  Nenchev,  D.N.,  1981,  “Kinematic  control  of 
redundant  manipulators,”  Proc.  11th  Int.  Symp.  on  Industrial  Robots,  Tokyo,  Japan, 
October  7-9,  pp.  561-568. 


Liegeois,  A.,  1977,  “Automatic  supervisory  control  of  the  configuration  and  behavior 
of  multibody  mechanisms,”  IEEE  Trans.  Systems,  Man,  Cybern.,  SMC-7,  pp.  868-871. 


Litvin,  F.L.,  Costopoulos,  T.,  Perenti  Castelli,  V.,  Shaheen,  M.,  and  Yukishige,  Y., 
1985,  “Configurations  of  robot’s  manipulators  and  their  identification,  and  the  execution 
of  prescribed  trajectories.  Part  2:  Investigations  of  manipulators  having  five,  seven,  and 
eight  degrees  of  freedom,”  ASME  J.  Mechanisms,  Transmissions,  and  Automation  in 
Design,  107,  pp.  179-188. 


Maciejewski,  A.A.,  and  Klein,  C.A.,  1985,  “Obstacle  avoidance  for  kinematically  re¬ 
dundant  manipulators  in  dynamically  varying  environments,”  Int.  J.  Robotics  Research, 
4  no.  3,  pp.  109-117. 


Nakamura,  Y.,  1985,  Kinematical  Studies  on  the  Trajectory  Control  of  Robot  Ma¬ 
nipulators,  Ph.D.  Thesis,  Kyoto  Univ.,  June. 


Nakamura,  Y.,  and  Hanafusa,  H.,  1985,  “Task  priority  based  redundancy  control  of 
robot  manipulators,”  Robotics  Research:  The  Second  International  Symposium,  edited 


Tit 


.*  «•  . 


ft 


14 


by  H.  Hanafusa  and  H.  Inoue,  Cambridge,  Man.,  MIT  Press,  pp.  155-162. 


Paul,  R.  P.,  and  Stevenson,  C.  N.,  1963,  "Kinematics  of  robot  wrists,"  Int.  J. 
Robotics  Research ,  2  no.  1,  pp.  31-38. 

Strang,  G.,  1980,  Linear  Algebra  and  Its  Applications ,  New  York,  NY,  Academic 
Press,  Inc.,  pp.  137-144. 

Takase,  K.,  Inoue,  H.,  and  Sato,  K.,  1974,  "The  design  of  an  articulated  manipulator 
with  torque  control  ability,”  Proc.  4th  Int.  Symp.  Industrial  Robots ,  Nov.  19-21,  pp. 
261-270. 

Trevelyan,  J.P.,  Kovesi,  P.D.,  and  Ong,  M.C.H.,  1984,  "Motion  control  for  a  sheep 
shearing  robot,”  Robotics  Research:  The  First  International  Symposium,  edited  by  M. 
Brady  and  R.  Paul,  Cambridge,  Man.,  MIT  Pren,  pp.  175-190. 

Uchiyama,  M.,  Shimizu,  K.,  and  Hakomori,  K.,  1985,  "Performance  evaluation  of 
manipulators  using  the  Jacobian  and  its  application  to  trajectory  planning,”  Robotics 
Research:  The  Second  International  Symposium,  edited  by  H.  Hanafusa  and  H.  Inoue, 
Cambridge,  Man.,  MIT  Pren,  pp.  447-456. 

Vukobratovic,  M.,  and  Kircanski,  M.,  1984,  "A  dynamic  approach  to  nominal  tra¬ 
jectory  synthesis  for  redundant  manipulators,”  IEEE  Trans.  Systems,  Man,  Cybern., 
SMC-14,  pp.  580-586. 

Whitney,  D.E.,  1969,  "Resolved  motion  rate  control  of  manipulators  and  human 
prostheses,”  IEEE  Trans.  Man-Machine  Systems ,  MMS-10,  pp.  47-53. 

Whitney,  D.E.,  1972,  "The  mathematics  of  coordinated  control  of  prosthetic  arms 
and  manipulators,”  ASME  J.  Dynamic  Systems,  Meas.,  Control ,  pp.  303-309. 

Yoshikawa,  T.,  1984,  "Analysis  and  control  of  robot  manipulators  with  redundancy,” 
Robotics  Research:  The  First  International  Symposium ,  edited  by  M.  Brady  and  R. 
Paul,  Cambridge,  Mass.,  MIT  Press,  pp.  735-748. 

Yoshikawa,  T.,  1985a,  "Manipulability  of  robotic  mechanisms,”  Int.  J.  Robotics 
Research ,  4  no.  2,  pp.  3-9. 

Yoshikawa,  T.,  1985b,  "Dynamic  manipulability  of  robot  manipulators,”  Proc.  IEEE 
Conf.  Robotics  and  Automation,  St.  Louis,  Mar.  25-28,  pp.  1033-1038. 

Yoshikawa,  T.,  1985c,  "Analysis  and  design  of  articulated  robot  arms  from  the  view¬ 
point  of  dynamic  manipulability,”  Preprints  3rd  International  Symposium  of  Robotics 
Research ,  Gouvieux  (Chantilly),  France,  October  7-11,  pp.  150-156. 


15 


/W  * 


0  6/1 


